
int escvalr=MIDRC-500;
int escvall=MIDRC-500;
int escvalre=MIDRC-500;
int yawval=MIDRC;
void setupESC()
{
escvalr=MIDRC-500;
escvall=MIDRC-500;
escvalre=MIDRC-500;
yawval=MIDRC;
  escLeft.write(escvall);
  escRight.write(escvalr);
  escRear.write(escvalre);
  servoYaw.write(yawval);

  escLeft.attach(esc_PIN_st);
  escRight.attach(esc_PIN_dr);
  escRear.attach(esc_PIN_sp);
  servoYaw.attach(yaw_PIN);
  
  escLeft.write(escvall);
  escRight.write(escvalr);
  escRear.write(escvalre);
  servoYaw.write(yawval);
  delay(2000);
  escvall=MIDRC-500;
  escvalr=MIDRC-500;
  escvalre=MIDRC-500;
  escLeft.write(escvall);
  escRight.write(escvalr);
  escRear.write(escvalre);
  servoYaw.write(yawval);
}


////////////////////////////////////////////////////////////////////////////////////////////////////////////////
void updateESC()
{
/*  
  escvalr=MIDRC+channelOut[FRONTR];
  escvall=MIDRC+channelOut[FRONTL];
  escvalre=MIDRC+channelOut[REAR];
  yawval=MIDRC+channelOut[YAW];
  escLeft.write(escvall);
  escRight.write(escvalr);
  escRear.write(escvalre);
  servoYaw.write(yawval);
*/  
}


